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I. IMJIODOctioh 



Future ballistic missiles may need the ability to ‘spin 
during boost ascent through the atmosphere as a counter- 
measure against first-generation continuous-duty laser 
threats. Since the conventional missile control design has 
uncoupled pitch, yaw and roil channels, some performance and 
even system stability may be lost in rolling the missile. 
This study evaluates the performance of a conventional 
pitch-yaw controller in the presence of spin. & compensa- 
tion scheme is then proposed to restore system performance. 

The block diagram of a submarine- launched ballistic 
missile's pitch- yaw control system is used as the design 
vehicle for this study. Since the physical parameters of 
this system are classified, only the block diagram is used 
in the analysis and design process. All numerical values 
needed for analysis and simulation are borrowed from other 
systems or derived as needed. 

The study is conducted as follows. First, the basic 
laws of notion and thrust vector control are introduced. 
Together, these sets of equations define the flight dynamics 
of the missile and the method for controlling the missile. 
The pitch-yaw controller for the non-rolling missile is then 
designed and simulated. This system has uncoupled channels 
for pitch and yaw control which besome coupled when the 
missile is rolled. Next, the missile is forced to roll and 
the effect cross-coupling has on the system's performance is 
analyzed. A compensation scheme is then proposed to restore 
the system's performance. Analysis and design are carried 
out using classical and modern controls analysis and 
simulation results ate presented. 
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A. HISSILE DIMAHICS AND lUBOSI VEClOB CCNIBOL 

No tat ion and Beference A^s Systei 

Ihe reference axis system used tc define vector 
quantities, dimensions and angles of interest is shovn in 
Fig. 1-1. Ibe axis system is fixed within the missile body 
with its origin at the missile’s center of gravity. The 
orthogonal axes, x, y and 2 , will also be referred to as the 
roll, pitch and yaw axes, respectively. Fig. 1-1 indicates 
that the right-hand rule is used to determine the positive 
direction for rotational vector quantities. 




Fig. 1-1 Reference Axis System 
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Table 1-1 lists the symbols used 
parameters and quantities of interest, 
be defined as they arise. The moments of 
center of gravity (eg) are defined as; 



A = Z iJm (y**z2) 



B = Z d^m (z2 + x*) 



C = Z dm (x2*y2) 



The products of inertia are defined as: 



D = Z (d’m) yz 



E = Z (dm) xz 



F = Z {6m) xy 



sum of differen 
tedy- 



Hhere Zdm symbolizes the 
which make up the missile 



to refer to key 
ether symbols will 
inertia about the 



( 1 . 1 ) 



( 1 . 2 ) 



(1.3) 



(1.4) 



(1.5) 



( 1 . 6 ) 



ial mass elements 
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lABLE 1-1 

NOTATION CEPINITIONS 





Roll Axis 


Pitch Axis 


" 

Yaw Axis 




X 


y 


z 


Angle of incidence 


X 


0 


y 


Angular rate 


P 


q 


r 


Component of missile 
velocity along axis 


u 


V 


w 


Component of force 
on missile along axis 


X 


Y 


2 


Moments acting on 
missile about axis 


L 


M 


N 


Moments of inertia 
about each axis 


A 


B 


C 


Products of inertia 


D 


E 


F 








j 



2- Eu le c *s Equ atio ns of Moti on 

The equations of motion foe a body with six degrees 
of freedom and a mass, m, are summarized belom. A dot (•) 
over any symbol refers to the time rate of change, d/dt, of 
the quantity indicated- [Bef. 1] 

m(6 + q« - rv) = X (1.7) 



m(v ♦ rU - pv) = X 



( 1 . 6 ) 



m (w - qU + pv) = Z 



(1.9) 
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Ap - (B-C)qr * C(r2-q2) _ E (pg^r) ♦ p (tp-g) = L (1.10) 

Bg - (C-A)tp ♦ E(p2-r2) - F(gr + p) ♦ D (pg-r) = H (1.11) 

Cr - (A-B)pg ♦ F(g*-p2) - D(rp + g) ♦ E (gr-p) = N (1.12) 



Ihe first three eguations above are force egaations 
and the second three are monent eguaticns. In particular, 
Egs. (1.11) and (1.12) are those from which pitch and yau 
angular accelerations are found. Note that the second term 
in each of these eguations constitutes a cross-coupling term 
between the two channels which is proportional to the roll 
rate. Ihis cross-coupling effect is eliminated in the 
conventional pitch-yaw controller design by preventing roll 
and thus setting the roll rate, p, egual tc zero. 

Assuming that the missile body is approximately 
rigid leads to the conclusion that the products of inertia 
are egual to zero. Thus Egs. (1.11) and (1.12) are reduced 
tc: 



Bg - (C-A)rp = M 



(1.13) 



Cr - (A-B) pg = N 



(1.14) 
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the 



Vector Control 

Ihe only means used to control the flight of 
missile under study is to deflect the exhaust nozzle as 
shown in two dimensions in fig. 1-2. Eeflecting the exhaust 
nozzle causes the driving force of the rocket motor to fce 
pointed in a direction other than along the missile's longi- 
tudinal axis. Ihis action creates force components 

perpendicular to the roll axis which do not act through the 
missile's center of gravity. The resulting moments are 
about the y- and z-axes and cause the missile to pitch and 
yaw. The moments about the center of gravity caused by the 
deflected thrust vector are: 



n = (iz)ic 



( 1 . 15 ) 



N = (l/)lc 



( 1 . 16 ) 



Where 1^ is the length from the missile's center of gravity 
to the point of application of the thrust (exhaust nozzle) 
and Zy and lateral thrust components parallel to 
the y-axis and z-axis. If dg and d<j/ are the angles of 
nozzle deflection in the pitch and yaw planes, then the 
perpendicular thrust components ate related to the total 
rocket motor thrust by the following equations: 



Zy = l*sin(dvp) 



( 1 . 17 ) 



= I*sin(dg) 



( 1 . 18 ) 
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Fig. 1-2 Thrust Vector Control 



Assuming that the maximum angle of nozzle deflection 
is small, as it must he for any physical system of this 
type, permits further simplification of Egs. (1«15) and 
(1.16) to the linear Egs. (1.21) and (1.22). 

sin(d@) ^ dg (1.19) 



sin (di|^) = dy 



1 1 



( 1 . 20 ) 



« = ■^•'30-ic 



( 1 - 21 ) 



N = (1.,22) 

Equations (1.21) and (1.22) give the Dooents in 
pitch and yaw caused by the cocket motor. Combining these 
two equations with the general rotational motion equations 
in pitch and yaw, Eqs. (1.13) and (1.14), permits formula- 
tion of the general differential equations for pitch and 
yaw. 



T-d@*lc = Bg - (C-A)rp 



(1-23) 



T‘d<|;‘lc = Cr - (A-B)pq (1-24) 

Solving for the angular acceleration components gives: 
g = (1/B)i;i-d0- 1^ ♦ (C-A)rp] (1.25) 



r = (1/C)[l-dvp'l^ + (A-E)pg] 



(1.26) 



Equations (1.25) and (1.26) point out the cross- 
coupling effect that the roll rate, p, has on the system. 
For instance, if the roll rate is set equal to zero the 
equations for pitch and yaw are completely uncoupled. 



q = (1/E) T-dg* 1^ 



(1.27) 



r = (1/C) !• d^y 1^ 



(1.28) 
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Figure 1-3 depicts the tolling pitch-yaw system just 
described in blocJc diagram form and highlights the cross- 
coupling terms introduced by roll. Ihe classical missile 
control system design approach assumed that the roll rate 
was small and went to great lengths to ensure this was true. 
Making the assumption that the coll rate is negligible 
allows the system designer to separate the pitch and yaw 
channels and deal with them independently. This study will 
analyze the effect cross-coupling has on stability and 
performance and formulate a compensation scheme for the 
cross-coupled system. 




Fig. 1-3 Thrust Vector Control Dynamics 
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II. fiEVELOPflBNT OF TgE NOM-BOLLIHG HISSILE 



The strategic nissile whose pitcii-yaw control systei 
will be used as the design vehicle for this study. The 
block diagraa of the system's pitch-yaw control system 
(without roll) is shown in Fig. 2-1. Since the physical 
parameters of this missile are classified, only the block 
diagram will be used. All system constants and physical 
parameter values which are used for analysis and simulation 
will be taken from other systems or derived as needed. 

The missile is a three-stage booster rocket. Flight of 
the missile is controlled by vectoring the exhaust thrust as 
described in the preceding section. Based upon predeter- 
mined flight trajectories and measured or estimated parame- 
ters during flight, the guidance computer generates pitch 
and yaw commands and transmits these to the pitch-yaw 
controller [Bef. 2]. The algorithm which the guidance 
computer uses to generate the pitch and yaw commands will 
not be addressed. Only the response of the pitch-yaw 
controller to a general set of commands will be considered. 

Table 2-1 lists the physical parameter values used at 
the various stages for design and simulation. These parame- 
ters bear no resemblance to those of the Trident II missile 
but serve only to provide actual numbers for the variables 
so that simulation could be done. The parameters listed in 
Table 2-1 were actually taken from the Saturn V Bocket; also 
a three-stage booster rocket. The moments of inertia listed 
in Table 2-1 were obtained from the other parameters Ly 
assuming that each stage has approximately the same inertial 
characteristics as a uniform right-circular cylinder. 
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Fig. 2-1 Non-Holling Pitch-Ya« Control System 



Figure 2-1 shows the schematic bloclc diagram of the 
system used to control pitch and yaw in the missile. Since 
the missile does not spin, the pitch and yaw channels are 
uncoupled. The system consists of a servo-actuator used to 
deflect the exhaust no 2 zle, the missile dynamics and sensors 
which feed back, angular velocity and position. The deflec- 
table exhaust nozzle saturates at a maximum deflection of 
five degrees. In this analog system all gains are constant 
throughout operation. 
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TABLE 2-1 



PHYSICAL PABAflETEF SPECIFICATIONS 







1st stage 


2nd Stage 


- 

3rd Stage 


Initial Mass 


slugs 


1.488x10^ 


5.22x10^ 


8.14x10^ 


Mass Rate 


slug/sec 


950 


81.49 


14.75 


Thrust 


Ibf 


7.496x10^ 


1.125x10^ 


2.249x10^ 


Length 


ft 


153 


150 


100 


Burn Time 


sec 


150 


559 


479 


Moment of Inertia 
about Pitch Axis 


slug-ft^ 


m(1542.i; 


01(1476.4) 


m(858.5; 


Moment of Inertia 
About Yaw Axis 


slug-f t^ 


m(l542.l) 


m(l476.4) 


m(858.5) 


Moment of Inertia 
1 about Roll Axis 

1 

1 


slug-ft^ 


m( 1 36, 1 j 


mU36.i; 


m(50.o; 
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A 



DESIGM OP THE SEHVO-ACIOATOB 



The transTer function of the 3ervo-dC tuator which 
deflects the exhaust nozzle of the oissile is given in Eq. 
(2.1). The task is to select ouaerical values for the 
parameters, a, b and f, such that the servo-actuator has 
acceptable performance characteristics. Again, the param- 
eter values will be selected without regard to those used on 
the actual missile. 



dm (s) ^ ab2 

(s) (s ♦ a) (s2 ♦ 2fbs ♦ b'^) 



( 2 . 1 ) 



It is desired that the actuator's performance resemble 
that cf a well damped second-order system with minimum over- 
shoot and a short settling time in response to step inputs. 
These performance characteristics need to be more stringent 
than those imposed on the entire system so that the actmtor 
does not become a limiting element when the entire system is 
considered later. The design specifications used for the 
actuator are summarized as follows, 

1. Pole Locations 

In order to ensure that this third-order system 
behaves essentially as a second-order system, the real pole 
must have a magnitude significantly greater than the real 
part of the complex roots of the second-order term, e.g. 



a > lOfb 



( 2 . 2 ) 



2 . 

exhibit 



Da mping 

In order to make the dominant complex pair of poles 
good damping, the value of f must approach one. 
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1 > f > 0.8 



(2.3) 



3* Se ttlin g lije 

In order to keep the actuator fron liiiting the 
settling tine of the entire system, the servo’s settling 
time must be significantly shorter than that of the pitch- 
yaw controller- If the desired settling time of the entire 
system is to be approiimately ten seconds and the actuator's 
settling time is 331 of the system’s, then the actuator's 
settling time will be selected according to the relationship 
below. 



^settling servo - ^settling system 
Cvershoot 

Ihe peak overshoot of the servo-actuator must be 
small. Otherwise, it may have an appreciable effect on the 
overall system’s peak overshoot. 



M(setvc) - 1 < 131 



(2.5) 



Where H (servo) is the peak overshoot of the actuator. 

Equation (2.5) permits selection of the appropriate 
damping ratio, £. If the system is assumed to exhibit 
second-order characteristics, then Eg. (2.6) can be solved 
for the damping ratio. 



M (servo) 



exp 



- 11 ^ 



< 0.01 



( 2 . 6 ) 



Solving for the damping ratio, f, yields the following. 



f > 



[In(O.OI) 

♦ [ In(O.OI) ]2 



= 0.826 



So, a damping ratio of 0.9 will be used, 
also satisfies Eg. (2.3). 



(2.7) 



This selection 



The specification of Eq. (2.4), combined with the 
above choice of damping ratio, can be nsed to select the 
natural frequency of the second-order term. 



t 



settling servo 




0.3 sec 



Solving for the natural frequency leads 
equal to 15. 



( 2 . 8 ) 

to a selection of b 



b > 14.8 tad/sec 



(2.9) 



Equation (2.2), combined with the above choices of 
damping ratio and natural frequency, leads to a selecticn of 
the real pole, a, equal to 150. 

a > lOffc = 135 (2.10) 



The root locus of the system's characteristic equa- 
tion, obtained by varying the real pole, a, is shown in Fig. 
2-2. Highlighted are the toot locations for the ahove 
choice of parameter values. As shown in fig. 2-2, all the 
roots are well into the left half of the s-plane, a large 
phase margin exists for the second-order complex pole pair 
and the second-order pair is far enough to the right c£ the 
single real pole to achieve dominance. Figure 2-3 shows the 
open-loop frequency response of the actuator and makes the 
large phase margin more evident. Figure 2-4, the closed- 
loop frequency response, points out the limitation of the 
actuator to follow input signals of frequency greater than 
about 10 radians/second . Figure 2-5 shows the step response 
of the system and as indicated, it meets the design specifi- 
cations. Note that although the simulation shown in Fig. 
2-5 is that of a full step of unit magnitude, the nczzle 
actuator saturates at a maximum angle of deflection of 
0.0873 radians (5 degrees). 
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o 

p- 




Fig. 2-2 Secvo-Actuator Boot locus Plot 

Figure 2-2 shows that the magnitude of the real pole 
is fat greater than the teal part of the complex pair and, 
therefore, will have little effect on the system's perform- 
ance. Also, the dominant seccnd-order pair is well damped 
with approximately a 72-degree phase margin and an effective 
damping ratio of 0.95. Ihe system is static as long as the 
term, ab^, remains less than 7.57 x lO^. 
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(»ap) aSVHd 




(ap) aaniiNDvif 

Fig. 2-3 Servo- Actuator Ofen-Loop Frequency Response 



21 



FREQUENCY (o. ra<V%ec) 



Odd 



(»ap) asvHd 




(ap) aaruiNDVw 



Fig. 2-4 Servo-Act uator Closed-Loop Freguency Besponse 
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FREQUENCY ip, nd/acc) 




Fig- 2-5 Secvo-Actuat oc Step Besponse 
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TIME (se^.) 



B. DESIGN OF IBS PITCB-IAi CONIBOLLEB 



Ihe block diagraa of the pitch-jan contcol systea is 
shown in Fig. 2-1. Since the pitch and yaw channels are 
identical and decoupled only one of them need be considered. 
The parameters ) and (K 4 ,) will fce selected so 
that the system will exhibit minimal overshoot to step 
inputs and have a settling time less than ten seconds. The 
one-channel system to be considered is shown in Fig. 2-6. 




Fig. 2-6 Fitch or law Channel Block Diagram 



la order to begin the analysis, it is necessary to 
temporarily ignore the nonlinear saturation of the servo- 
actuator. The linearized transfer function for the pitch- 
yau control systes then becomes that of £g. (2.11). 



0(s) = Kgabailg/fi (2.11) 

9c (s) ss + s*(a*2fb) ♦ s3(b2e2fba) ♦ s* (ab2) 

♦ s(K^^ Kgat^Il^/B) ♦ K^ab2Tl^/E 

The denominator of Eg. (2.11), when set equal to zero, 
defines the system's characteristic equation. The charac- 
teristic equation may be partitioned as follows. Define a 
new variable, J. 

J = ab*K (11 /B) (2.12) 

6 C 

The characteristic equation now becomes; 

s5 ♦ s^(a+2fb) ♦ s3(b2+2fba) (2.13) 

♦ s^(ab^) s ( J) + J — 0 

Bearranging yields the partitioned form shown below. 



Kj.eS +1 = -1 (2. 14) 
s« ♦ s»(a + 2fb) ♦ s3(b2 + 2fba) ♦ s2(aba) T 

Equation (2.14) is in the form for root locus analysis 
where J is treated as the open-loop gain and the left side 
of the equality as the open-loop transfer function. Varying 
Kr© and J together sweeps out a region in the s-plane into 
which the roots of the characteristic equation can be 
located. These "root relocation zones" are shown in fig. 
2-7. [Eef. 3] 

Figure 2-7 was made by varying J and K re in Eg. (2.14) 
and plotting the root locations. For example, if Kpe = 0 
then Eg. (2.14) contains fiwe finite poles and five zeros at 
infinity. The coot locus will follow the path indicated in 
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Pig. 2-7 (as J increases). Note that the real pole at -150 
is not shown in Fig. 2-7. As Kt« is increased incrementally 
from zero towards infinity and the saae procedure is used, 
i.e., plot the root locus over a large (positive) range of 
J, then a family of root loci will he swept out. Ihe cross- 
hatched area in Fig. 2-7 is the area enlosed by the coot 
loci for J and varying from 0 to cso. 




Fig. 2-7 Boot fielocation Zones of Pitch-Yaw Controller 
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with 



Figure 2-7 indicates that the systea is unstable, 
two roots in the right half-plane, for values of less 

than or equal to zero. The values of K and J are esti- 
mated as 0.8 and 1.57 1 105, respectively. This selection 
locates the characteristic egnation roots as shown in fig. 
2-8. The open-loop gain, K^, was found, from the definition 
of J, to range between the values shown below. 

1st Stage 2nd Stage 3rd Stage 

1.071-0.07 1.51-0. 14 1.45-0. 19 

Exact solutions for Kq and K were not obtained analyt- 
ically since the system contains a nonlinear satuiation 

effect which was ignored in constructing the root locus. 

Also, Kg is a function of system parameters which change 
continuously during flight and dramatically at booster stage 

separations. To fine tune the selection of and , 

simulation studies were conducted using DSI/360 during each 
of the three booster stages of operation- The results of 
the simulations, for various values of Kj,g , are shown in 
Figs. 2-9, 2-10 and 2-11, where 0 is given as a function 
time. 

The simulations illustrated that the gain, , has 

little effect on the system's performance. This is because 
it is "upstream” from the saturated nozzle actuator and, as 
such, can only shorten the time required for the actuator to 
reach maximum deflection. Since this time is already small 
compared to the system's response. Kg has negligible effect. 
To simplify the problem. Kg was set equal to one. The 
velocity feedback gain Kj.g has a pronounced effect on both 
the overshoot and the settling time of the system. From the 
simulations, Kj.g was selected to be 1.5. This choice 
ensures the specified settling time of ten seconds during 
all stages and results in overshoot only during stages one 
and two, where it is less than ten percent. 
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Fig. 2-8 Rcot Selection of Partitioned Equation 
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(RADIANS) 




TIME (SEC) 



Fig. 2-9 First Stage Simulation of Pitch-Yau Controller 
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Fig . 2-10 



Second 



Stage Siaulation of Pitch-la« Controller 
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(RADIANS) 




TIME (SEC) 

fig. 2-11 Third Stage Simulation of fitch-Yaw Controller 
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III. EFFECl OP BOLL 



Hhen the non-rolling pitch-jaw control sjstea just 
designed is forced to roll, the system tecomes cross-coupled 
as shown in Fig. 3-1. The mechanism which creates and main- 
tains the rolling motion will not be considered. It is 
assumed that a control system outside the pitch-yaw 
controller and independent of the main thrust motor main- 
tains an approximately constant roll rate, p. Furthermore, 
it is assumed that the roll rate can be measured during 
flight or estimated from measured parameters with reasonable 
accuracy. The purpose of this section is to analyze the 
effect roll has on the previously non-rolling pitch-yaw 
controller. 

The Laplace transformations of the linearized non- 
rolling system*s governing differential eguations can be 
written as two separate equations; one for the pitch channel 
and one for the yaw channel. 



s20 ♦ GK^^se ♦ G0 = G9g 



(3. 1) 



s^r ♦ HKj,^sf + = Hfp 

Where G and H are defined as: 



(3.2) 



G 



H 



Ke(11c/B) 



K^<Tlc/C) 



ab2 

- (s*a) {s* + 2 f bs* b*) - 

' a^2 ’ 

- (s*a) (s2 + 2f bs + b^). 



(3.3) 



(3.4) 
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Fig. 3-1 Rolling Pitch-Xaw Controller Block Diagram 
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Eguations (3.1) and (3.2) can be rearranged and put into 
matrix form as shown in Eg. (3.5). Note that the eguation 
has oni; diagonal non-zero elements and is, therefore, 
uncoupled. 



(3.5) 



Bolling the missile leads to the addition of cross- 
coupling terms between the eguations governing pitch and yaw 
response. The transformed differential eguations governing 
the responses of the rolling system are: 



S 2 ♦ G K 1^0 S G 0 


0 


_ 


G 0 






0 s2*BKrS'S + H. 






.0 




Jc. 



S20 ♦ GKpg S0 ♦ G0 ♦ QsV = GO^ 



(3.6) 



S2T ♦ HKrySr ♦ ♦ Bs0 * Hfc 



(3.7) 



Where G and H are defined in Egs. (3.3) and (3.4) and Q and 
B are defined in Egs. (3.8) and (3.9). 



C = (A - C)p/E 



(3-0) 



B = (E - A) p/C 



(3.9) 



Bearranging Egs. (3.6) and (3.7) into matrix form as before 
leads to the coupled form: 



"32 + Gf^Q s*G Cs 


0 




G 0 ’ 




■9c‘ 


£S s2*HKj.^s*H 


y. 




0 H_ 







(3. 10) 



Eguation (3.10) shows that the introduction of roll has 
affected the transfer functions which determine the input- 
to-output relationships of the system in two ways. first. 
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it has changed the direct path transfer fanctions of 
pitch-to-pitch and ja«-to-yavj connand-to-output. Second, 
roll has introduced pitch-to-yau and jaw-to-pitch coaiand- 
to-output transfer functions which were zero before the 
missile was forced to roll. Ihe effect that these changes 

have on the systea*s stability and performance will be exam- 
ined next. 

A- EFFECT OF HOtl OH SISTEB STABILITY 

As pointed out, the rolling system is governed by four 
transfer functions (2 inputs x 2 outputs) . Consider cnly 
the pitch-to-pitch input- to-output transfer function, i.e., 
hold the yav-command input equal to zero and ignore the yaw 
output. Under these conditions, the block diagram of the 
system may be rearranged as shown in Fig. 3-2. The transfer 
function obtained from the diagram is given in Eg. (3.11). 
As indicated, the pitch response of the system is influenced 
by a variety of system parameters, as it was before the 
missile was rolled. Now, however, the root locations of the 
system are also affected by the roll rate. 

0(S) = N5SS+N4S*+KjS3+N2S2*N^S+Nq (3.11) 

0 Q (s) s*o*CgS®+D 0 S» + DYS’*DgS*<-D^sS*D^S^ 

♦ s2 + L| S*Dq 

where ; 

N5 = (abVB)llc*^e 

= (ab2/B) Il^H^(a*2fb) 

Nj = (ab2/B)Tl^,Kg(t2 + 2fba) 

= {ab 2 /B)Il^Kg (at*) 

Nq = (at2/B)Tl^K^ (KyabZTl^ /C) 

= 2 (a* 2 fb) 
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D-= 2(b«»2fba) * £ (A-B) ( A-C) p2/CB J ♦ (a+2£b)2 = 

O 



^81 * ®82P" 



Dy= 2ab* f 2 (a + 2fb) (b2«-2£ba+[ lA-B) (A-C) p2/CB ]) = D 71 f C 72 p2 



Dg= (b2»2fba) (b2*2fba <• 2[ (A-E) (A-C) pZ/CE J) 

♦ (ab2-ri^,)[ (K^^K^/C) + K^/B) ] ♦ (a+ 2 ab) (2ab2) 

♦ [ (A-B) (A-C) p2/CB](a + 2£b)2 = ♦ %2 E* 

05 = (ab2Tlc)[ (K 9 /B) + iKv/CJ ] ♦ 2[ ( A-B) ( A-C) p2/CB ] (afaZ) 

♦ 2 (b 2 + 2 £ba) (ab 2 ) * 2[ <A-B) (A-C) pZ/CE ] (bz + 2£ba) (a + 2£b) 

♦ (a*2£b) (abZTJc )[ (Kpy Ky/C) ♦ (KreKe/E) ] = D51 ♦ £52?^ 



D^= (atz'Ilc)[ (Ky/C) + (Ke/E) Ha + 2£b) 

♦ 2[ (A-B) (i-C) p2/CB ] (a*2f b) (afaz) 

+ [ (KryKy/C) ♦ JKr© Ke/E),] (abzil^) (b2*2£ba) 

♦ [ (A-B) (A“C) p2/CE ] (b2»2£ba) 2 ♦ (ab2)2 = ♦ ^ 42 ?* 



D 5 = [ (Ky/C)MKe/B) ](ab 2 Tl^) (bz*2fba) 

+ 2£ (A-B) (A-C) p2/CB] (abZ) (b2*2£ba) 

♦ [ (KryKy/C) * (f^e Ke/E) ] < (abz-n^ ) abz ) = D 31 ♦ C 32 ?^ 



^2 = [ (K^-ZC) MK^/E) ](abz) (abzil^) 

♦ [ (A-B) (A-C) p2/CE](atZ)2 

♦ Kg/BC) (Tl^abZ) 2 = D21 ♦ £32 



D-, = Kg (abZTlc/CB) ZRp^ ♦ Kj,© K eCafaZTl^/CE) ZK,y 

Dq = £ (KyK^) {abzil^) 2 ]/CB 
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Fig. 3-2 Rolling System Rearranged with Yaw Suppressed 
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Ifae denominatcr of Eg- (3.11), when set egual to zero, 
defines the characteristic equation of the system. 
Examination of Eg. (3.12) (in which Eg. (3.11) defines the 
coefficients) shews that as the roll rate is increased from 
zero, the roots of the characteristic equation will move as 
a function of the squared rcll rate. For analysis, the 
region of operation will he restricted to the beginning and 
end of each booster stage. At these instants, the charac- 
teristic equation is as given in Eg. (3.12) with numerical 
values for the coefficients given in Table 3-1. The end of 
stage three is not considered because the missile is no 
longer performing powered flight at the end of the final 
stage. 



S»o ♦ DgS’ ♦ (D 01 *D 02 p 2 ) s« ♦ (D 71 ♦C - 72 ^*) S ^ (3.12) 

* (D 6 I *®62P*) 

( D j-| ♦ D^2 + ^^21*^2 ^ D^s ♦ — 0 



The "migration" of the system's roots as the rcll rate 
increases from zero is shown in Figs. 3-3 through 3-12. 
Figure 3-4, for example, shows that two roots of the system 
move into the right-half plane at a roll rate of approxi- 
mately 12.2 radians/second. Since the linearized character- 
istic equation was used to construct the root loci shown in 
Figs. 3-3 through 3-12, the precise value cf roll rate which 
causes instability cannot te determined from the figures. 
Shat the figures point out is the general migration cf two 
system roots into the right-half plane in all phases of 
operation as the roll rate is increased. 
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HABLE 3-1 



CfiAfiAClfBISTIC EQOAlIOIi COEFflClENIS 



1st stage 2nd Stage 3rd Stage 


Beginning End Beginning End Beginning 




354.0 


354.0 


354.0 


354.0 


354.0 


f— 1 

00 

Q 


39,879.0 


39,879.0 


39,879.0 


39,879.0 


39,879.0 


*^82 


0.9755 


0.9755 


0.9401 


0.9401 


0.8869 




1.5809x10^ 


1.5809x10® 


1.5809x10® 


1.5809x10 


1.5809x10® 


CM 


345.33 


345.33 


332.80 


332.80 


313.96 


>1 


3.0355x10^ 


3.0725x10^ 


3 . 0368x10^ 


3 . 0751x10*^ 


3.0549x10^ , 


/^62 


38,902.0 


38,902.0 


37,490.0 


37,490.0 


35,368.7 




3.1199x10® 


3.7781x10® 


3.1434x10® 


3.8236x10® 


3.4650x10® 


°52 


1.542x10® 


1.542x10® 


1.486x10® 


1.486x10® 


6 

1.402x10 




1. -7182x10® 


3.3458x10® 


1.7764x10® 


3.4584x10® 


2.571x10® 


°42 


2.9483x10^ 


2.9483x10^ 


7 

2.8413x10 


2.8413x10^ 


7 

2.6805x10 


°31 


4.8252x10® 


1.8385x10^® 


5.310x10® 


1.9324x10^® 


1.1929x10^® 


^^32 


2.815x10® 


2.815x10® 


2.7128x10® 


2.7128x10® 


8 

2.5593x10 1 


^21 


7.311x10® 


8.2761x10^® 


8.5265x10® 


8.1567x10^® 


3.389x10^® 


°22 


1.11x10® 


1.11x10® 


1.0708x10® 


1.0708x10® 


1.0102x10® 


''l 


5.794x10® 


9.5278x10^® 


7.0162x10® 


9.292x10^® 


3.5410x10^® 


r 

Ol 

Q 1 


1.931x10® 


3.176x10^® 


2.3387x10® 


3.0972x10^® 


1.1803x10^® 
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Fig. 3-3 Root Migration at Beginning of First Stage 




Figures 3-3, 3-5, 3-7, 3-9 and 3-11 show how the roots 
of the characteristic equation of the rolling missile move 
as the roll rate is increased. A close-up view of the 
migration around the imaginary axis is shown in Figs. 3-4, 
3-6, 3-8, 3-10 and 3-12. 
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Fig, 3-4 Beginning of First Stage Boot Higration Close-Up 
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Fig. 3-5 



Root Migration at End of the First Stage 
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Fig. 3-6 End of the First Stage Boot Migration Close-Up 
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Fig. 3-7 Root Migration at Beginning of Second Stage 
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Fig. J-8 



Beginning of Second Stage Root Bigration Close-Up 
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Fig. 3-9 Hoot Migration at End of the Second Stage 
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Fig. 3-10 



End of the Second Stage 



Boot fligration Close-Up 
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Fig. 3-11 Root Migration at Beginning of Third Stage 
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B. EFFECT OF BOLL OH STSTEH FEEFOBHAICE 

As shown, the intcodactioo of roll into the pitch-yaw 
controller caoses a nigration of two system roots into the 
right-half of the s-plane. As the roots approach the inagi- 
nary axis (as the roll rate is increased) the system begins 
to show more transient oscillation due to the decreased 
damping ratio. Ihe settling time of the system is also 
increased. Since the system contains the nonlinear satura- 
tion effect of the nozzle actuator and is of such high order 
(tenth), not much more than this qualitative observation was 
done analytically. 

To study the effect cf roll on system performance, a 
secies of simulation studies was conducted with the satura- 
tion effect present. The simulation studies were performed 
by subjecting the system to three sets of step-input 
commands and constant roll rates. The first study consisted 
of giving the system a step-pitch input and a zero-yaw input 
and observing the transient response at six roll rates 
between 2.5 and 15 radians/second. Ihe results of these 
simulations are plotted in Figs. 3-13 through 3-18. The 
second study involved subjecting the system to a zero-pitch 
input and a step-yaw input and conducting the same tests as 
the first study. The results of the second study are 
plotted in Figs. 3-19 through 3-24. Finally, the system was 
given both a step-pitch command and a step-yaw command and 
the tests were repeated. The responses of the system to the 
conditions of the third test are shown in Figs. 3-25 through 
3-30. Unlike the non-rolling simulations which were run at 
separate booster stages (Figs. 2-9 through 2-11), the 
rolling simulations were cun over several consecutive 
booster stages. This is because the settling time cf the 
colling missile system was often greater than the burn time 
of a single stage. 
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Fig. 3-13 Pitch-Step Besponse at Boll Bate of 2.5 cad/sec 



Figures 3-13 through 3-18 show the system's pitch and 
yaw responses to a pitch-step input and a zero-yaw input at 
the specified roll cate. Note the dramatically increased 
overshoot, oscillation and settling time compared to the the 
non-rolling simulations. Figs. 2-9 through 2-11. Figure 
3-18 shows shows the unstable response obtained at a coll 
rate equal of 15 rad/sec. 
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Fig. 3-14 



Pitch-Step Response at Boll Bate of 5.0 rad/sec 
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Fig. 3-15 Pitch-Step Response at Roll Rate of 7.5 rad/sec 
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Fig. 3-16 Pitch— Step Response at Roll Rate of 10-0 rad/sec 
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Fig. 3-17 Pitch- Step Response at Boll Bate of 12.5 tad/s 
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Fig, 3-18 Pitch-Step Eesponse at Boll Bate of 15.0 rad/sec 
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Fig. 3-19 Yaw-Step Response at Boll Bate of 2.5 rad/sec 

Figures 3-19 through 3-2<l show the system’s pitch and 
yaw responses to a yaw-step input and a pitch-zero input at 
the specified roll rate. In these simulations, as in the 
previous ones, the overshoot and settling time are increased 
above that observed in the non-rolling simulations of Figs. 
2-9 through 2-11. Figure 3-24 shows the unstable response 
at a roll rate of 15 rad/sec. 
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Fig. 3-20 Yaw-Step Response at Boll Fate of 5.0 rad/sec 
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Fig. 3-21 Yaw-Step Response at Boll Bate of 7.5 rad/sec 
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Fig. 3-22 



Yaw-Step Besponse at Boll Bate of 10.0 cad/sec 
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Fig. 3-23 Yaw-Step Besponse at Roll Bate of 12.5 rad/sec 
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Fig. 3-24 Yaw-Step Besponse at Boll Fate of 15.0 rad/sec 
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Fig. 3-25 Pitch- 8 Yaw-Step Response Roll Bate 2.5 rad/sec 



Figures 3-25 through 3-30 show the system’s pitch and 
yaw responses to pitch- and yaw-step inputs at the specified 
roll rate. Under these conditions, the under-damped oscil- 
lation observed in the two previous test is even more 
pronounced. 
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Fig. 3-26 Pitch- S Yaw-Step Besponse Boll Bate 5.0 rad/sec 
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Fig. 



3-27 Pitch- 
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Fig. J-28 Pitch- 6 Yaw-Step Response Roll Fate 10-0 rad/sec 
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Fig. 



3-29 Pitch- 



6 Yaw-Step Eesponse Roll Bate 



12.5 rad/sec 
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Fig. 3-30 Pitch- 6 Yaw-Step Eesponse Roll Bate 15.0 rad/sec 
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Ihe siiDulation studies showed that the systen begins to 
reach instability at a roll rate of approiimately 12 
radians/sGCond. However, at roll rates as low as 2.5 
radians/second the systea’s performance has been severely 
degraded froa the non-rolling case (figs, 2-9 through 2-11). 
In all cases, the naxioum peak overshoot is increased by a 
factor of at least five and the settling time by a factor of 
at least eight- Ihe system's performance is approximately 
that of an under-damped oscillator. This response is caused 
by the two roots which have moved close to the imaginary 
axis as the roll rate was increased and are dominating the 
system's transient response- In the next section, a compen- 
sation scheme is proposed which increases the damping of the 
system and partially cancels the cross-coupling acceleration 
terms introduced fcy roll. 
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IV. COHP EMSAIIOM SCH|H£ 



In the preceding chapter it was noted that rolling the 
missile had the effect of introducing cross-coupling terms 
into the pitch and yaw angular acceleration eguations <£qs. 
(3.6 and (3.7)). In order to completely restore the 
system’s performance to its non-rolling condition, it is 
necessary to eliminate or cancel out the cross-coupling 
terms. Equation (3.10) can fce rearranged into the form: 



'S2 Qs 




■ 0 


= 




RS S* 




_T 







The left side of Eq. (4. 1) contains the "dynamics” of the 
system. In other words, it gives the acceleration and 
velocity terms which determine the angular acceleration in 
the pitch and yaw channels. The only way to eliminate the 
cross-coupling terms directly would be to make changes to 
the left side of Eq. (4.1) which would cancel the terms, Qs 
and Bs6. This would involve dramatic changes to the missile 
body, thrust vector control system and flight performance 
and, therefore, will not be attempted. 

The right side of Eg. (4.1) constitutes the "elec- 
tronics" of the system. It contains a sum of those terms 
which are added at the feedback junction then passed through 
the nozzle actuator. This side of the equation can be 
changed easily by altering the electronic network that makes 
up the feedback Icop. 
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A. CfiOSS-CHAHHEl FEEDBACK 

Assuae that the pitch rate and yaw rate can be accu- 
rately aeasured or estiaated at any tine during flight. 
Also, assume that the terms, G; fl; C and £, all functions of 
system parameters, can be measured or estimated accurately. 
Then, addition of the feedback terms of pitch-rate-to-yaw- 
input and yam-rate-to-pitch-input permit cancellation of the 
cross-coupling terms. The block diagram realization of the 
proposed change is shown in Fig. 4-1. Equation (4.2) gives 
the compensated system’s transformed differential equation 



X matrix 


form. 




s2 Qs 




0 


r 


Rs S2 









G(0^ - K^eSQ - e ♦ Cs'l'/G) 



(4.2) 



Equation (4.2) can be reduced to Eg (4.3) by canceling 
the cross-coupling terms, Qs and FsC, from both sides of 
the equation. Comparison of Eq. (4.3) with Eq. (3.5) shows 
that the transformed differential equation of the rolling 
system has been reduced to its original non-rolling form. 
Note that all that was done in this compensation scheme was 
to subtract the cross-coupling term from the command input 
to the nozzle actuator so than when it is added 
downstream the result will be no effective 
terms into either control path. 



back on 
cross-channel 



S2 

0 



0 

s2 





0 " 


- 









G (0c - Kre S0 - 0) 
H(tc - Krysr - f) 



(4.3) 
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Fig. 4-1 Cross-Channel Feedback Compensation Scheme 
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Unfoctunately , the problea is not as siople as Eg. (4.2) 
implies. The nain problem is that the amount of control 
which can be used to force the system’s response is limited 
by the maximao deflection angle of the exhaust nozxle. This 
nonlinear saturation of the actuator is not present in Eg. 
(4.2). Figure 4-2 summarizes the problea. 



1 




J 



Fig, 4-2 



Plant Dynamics and Control Input Limitations 



Figure 4-2 shows that no matter what 
employed to generate the pitch and yaw 
control signals, they are limited and. 



feedback scheme is 
angular acceleration 
therefore, so is the 
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region of operation over nbich the perforaance of the system 
can be controlled and the degree of control possible. 

Figure 4-3 shons the cross-coupling terns and the 
attempted cancellation of then by the cross-channel feedback 
terns under the compensation scheme just proposed. ihe 
simulation shown was performed during the first stage of 
operation with the system subject to a pitch-step command 
and a zero-yaw command. Note how the magnitude of the 
cross-channel feedback term is effectively saturated by the 
nozzle actuator and cannot follow the cross-coupling term 
outside a small region of operation. Ihe simulaticn was 
made by subtracting the error term generated by the differ- 
ence in command and feedback so that only the cross-channel 
feedback term is fed-through the nozzle actuator. 

B. NONLIHEAB FEEBEACK 

Examination of Figs. 2-5, 2-9, 2-10 and 2-11 shows that 
the tine the nozzle actuator takes to reach maximum deflec- 
tion when given a large input command {>> maximum deflec- 
tion) is insignificant (0.05 sec) when compared to the 
settling time of the entire pitch-yaw control system. Thus, 
the actuator is functioning almost like a switch in all 
regions of operation except near the command input (steady 
state). For example. Fig. 4-4 shows the nozzle deflection 
in the pitch plane during a simulation when the system was 
subject to a pitch-step input and a roll rate of 2.5 
radians/second. The conclusion to be drawn from fig. 4-4 is 
that since the amplitude of the effective control input to 
the plant cannot be increased above saturation, the only 
alternative is to "throw the switch” a little sooner. 

The cross-channel feedback compensation scheme just 
proposed will cause a reduction in the effective servo 
command and result in earlier removal of the maximum nozzle 
deflection (turning off the switch). However, this approach 
can at best only follow the cross-coupling terms and can not 
"anticipate” the need to switch the deflection angle from 



positive naxinuiD to negative naxinum. Another nethod to 
accomplish the objective o£ switching the nozzle earlier is 
to vary the velocity feedback gains, K j-q and . 
Specifically, it is desired that the velocity feedback gains 
be low doring the initial phases of operation when the error 
between conmand and position is large and increase as the 
system approaches the commanded value. Ihis will result in 
the same basic system operation that was present before 
compensation {dominant complex-pair oscillation) but with 
low damping when the error is high and higher damping as the 
system approaches steady state. 

Ihe nonlinearity of the system prevents the use of most 
analytical tools which might be used to determine algorithms 
for K re and Rpy . Instead, a trial and error approach was 
used based on the observations of the system's performance 
during earlier simulations and simulation studies performed 
specifically to determine appropriate parameters. 

Assume that the algorithm for determining the velocity 
feedback gain consists of a constant which is reduced by an 
amount proportional to the error between command and posi- 
tion. This will result in low damping if the error is high 
and increased damping as the error decreases. For example, 
if V and H are constants, the pitch-channel velocity feed- 
back gain can be determined from: 



K 



re 




0 



(4.4) 



Furthermore, the simulations shown in Figs. 3-13 through 
3-30 indicated that the system becomes more underdamped 
(roots migrate toward the imaginary axis) as the roll rate 
is increased. So, the velocity feedback gains were made 
proportional to the roll rate. Normalizing the algorithm so 
that the relationship does not become zero if tbe roll rate 
is zero yields Egs. (4.5) and (4.6). 
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Fig. 4-3 Satucation of Ccoss-Channel Feedback 
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Fig- 4-4 No 2 zle Deflection Angle Siuulation 
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Figure 4-5 shous sample results of siaulation studies 
which were conducted for various values of V and H and over 
various stages of operation and roll rates. The simulations 
showed that acceptable performance was obtained for V =4 
and W = 3. 

Figures 4-6 through 4-14 show simulation results which 
were made bj using the cross-channel feedback and variable 
velocity feedback gain compensation schemes together. For 
comparison, the uncompensated responses are also shown. The 
compensated simulation responses were obtained under the 
same operating conditions as those shown in Figs. 3-13 
through 3-30. 




Fig. 4-5 Sample Algorithm Eesponse Test Simulation 
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Fig, 4-6 Pitch-Step Response Boll Bate of 2,5 rad/sec 
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Fig. 4-7 Pitch-Step Eesponse Roll Rate of 5.0 cad/sec 
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Fig. 4-8 Pitch-Step Response Roll Bate of 7.5 rad/sec 
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Fig. 4-9 Yaw-Step Response Roll Rate of 2.5 rad/sec 
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Fig. 4-10 Yaw-Step Response Roll Rate of 5.0 rad/sec 
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Fig . 



4-11 Yaw-Step Sesponse Foil Rate of 7.5 tad/sec 
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Fig. 4-12 Pitch- 6 law-Step fiesponse Boll Bate 2-5 rad/sec 
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Fig. 4-13 Pitch- 6 Yav-Step Gesponse Boll Bate 5-0 rad/sec 
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Fig 4-1^ Pitch- 6 Yaw-Step Besponse Bell Bate 7.5 rad/sec 



Ihe sioulatioQS indicate that substantial performance resto- 
ration is possible with the proposed compensation schemes. 
However, the restoration is not complete and is still much 
worse, in terns of overshoot and settling time, than the 
non-rolling missile. 
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V. COHCLOSIOMS 



The conpensa tion scheme proposed partially restores the 
pre-roll perforoaoce of the missile. Table 5-1 summarizes 
the level of performance degradation caused by roll and the 
restoration which was obtained with this compensation scheme 
under pitch- and yaw-step inputs and a roll rate of 2.5 
rad/sec. As indicated/ the degradation is significant even 
at this relatively low (and stable) roll rate. The compen- 
sated system's performance is still fat worse than that of 
the non-tolling system. 

The compensation scheme relies primarily on the nonli- 
near damping effect of the variable velocity feedback gains 
which "anticipate" the approach of the commanded position. 
Since the cross-coupling terms introduced by coll are not 
directly cancelled by the proposed modification, the region 
of stable operation and the degree to which the system's 
performance can be restored is directly controlled by the 
roll rate. Furthermore, the saturation caused by the nozzle 
deflection will prevent any compensation scheme, which only 
modifies the control input, from fully restccing the 
system's performance- To completely restore the system to 
its pre-roll performance at any roll rate, additional 
control inputs to the system plant dynamics (such as, side 
thrusters or additional vectoring of the main rocket motor) 
are necessary- 
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lABlE 5-1 



PERFORMANCE COMPARISON 





Non-Rolling 

System 


Uncompensated Compensated 

Bolling System System 

(p = 2.5 tad/sec) 


Settling Time 


9 sec 


140 sec 


80 sec 


Peak Cvershoot 


0,511 


170J1 


70% 
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APPENDIX A 

N0M>B0LLIH6 HISSILE SIEOIAIION 



Ihe DSL/360 program used to simulate the non-rolling 
missile is shovn below. Ihe program consists of three 
stages, initial, derivative and terminal. Ihe initial 
segment is used to define constants and calculate functions 
of the constants which will net change throughout the simu- 
lation run. Ihe derivative section is where the actual 
integrations regained to perform the simulations are 
conducted. This program is constructed to follow the block 
diagram of Fig. 2-1 directly. Note that the nozzle actuator 
transfer function was broken down into a three-step integra- 
tion. Ihe terminal stage determines the end condition of 
the simulation run and the output data. Ibis data was 
formed into a data file and a packaged graphics program 
(DISSPLA) was used to construct the figures shown in the 
teit. Ihe parameter values listed in this example program 
are those during stage one. 



♦ INII3ALIZE CONSIANTS 

CONST TST=7496000,L=363. J 1=1 1048.8- KIH= 1. 0, KB IH= 1.75,... 
^ HA=150,WB=15,PB = 0.9,BAIE = 930.0,M1= 189140 

♦ COMPDIE SET VALUES 
INITIAL 

ONE=HA* (WB**2) 

IM0=HA ♦ 2*PB+«E 
IHBEE=2*PB»VB*HA ♦ WB+*2 

♦ BEGIN SIflULATION 
DEBIVAIIVE 

IJASS=M1-BATE*1II1E 
PCCM=STEP (0) 

♦ EEROB SIGNAL 

E=PCOM-P 

EI = B- (KETH^PICOT) 

CM=KTH*EI 

♦ SERVO TBANSFER FUNCTION 

SVO = INTGBL rO.SV 1DOI1 
SV1D0I = INIGBL (0,SV2DCT) 

SV2DOT=INTGBL (0,SV3DCT) 

SV3DOT=ONE* (Ca-SVC) - TW0+SV2DCT - THBE£*SV1DOT 
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♦ LIflll OF NOZZLE DEFLECTION 

DEEL=LIHIT (-0. O073,O,O873,SVO) 

♦ MOHENI OF IHEBIIA 

E=J1*MASS 

Z=IST*L/B 

♦ ANGULAB ACCELEBATION 

P2DOT=Z*DBFI 

♦ ANGULAB VELOCllI 

PlDOT=INTGRLiO, P2DOT) 

^ P=INTGBL (0, P1DOT) 

♦ OUTPUT AND CONTBOL STATEMENTS 
lEBMINAL 

CONIBL FINTIfl=15.0, DELT = 0.001 

SAVE 0.015,P 

PBINT 0.015,P 

END 

STOP 
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IPPENDIX B 

BOLLING BISSILS SIHULAIICN 



Uollke the non-rolling systen simulations, the colling 
missile simulations were required to run over several 
consecutive booster stages. Ibis required the addition of a 
'dynamic* segment of simulation. The 'IF* statements, shown 
in the example simulation below, are used to switch from one 
set of parameters to another as one stage burns off and 
another starts. The switching is controlled by the elapsed 
time of the simulation run compared to the burn time of each 
stage. 



♦ SET CONSTANTS 

CONST KTH=1. 0,KBTH=1. 5 , WA= 1 50 , W B= 1 5 , PB=0. S,eCLL=7- 5 

♦ INITIALIZE SET VALUES 

INITIAL 

A = WA*(WE**2) 

B = WA ♦ 2*EB*HE 
C = 2*PE*NB*WA + WB**2 
EESET^O* 0 

♦INITIALIZE FIBST STAGE VALDES 
TST=7496000 
1=363 

Jl=11048.8 
J2=136, 1 
EATE=930.0 
M1= 189140 

♦ 

♦ DECIDE WHICH STAGE OF FLIGHT 

DINAHIC 

♦ ENTEB STAGE TWO 

IF (TINE. IT. 150) GO TO 10 
TST=1125000 
L = 230 
J1=i*476.4 
BATE=81 .49 
M1=40340 
BESET=150 

♦ ENTEB STAGE THEEE 

IF (TIME. LT. 509) GO IC 10 
TST=224900 
L=100 
J1=858.3 
J2=50.0 
EATE=14.75 
M1=8140 
BESET=509 

10 CONTINUE 
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* 

♦ SIHUIATION BUN 
DBBIVAIIVB 

SB1=TIHE-BES£1 

J3ASS = m - iBATE+SET) 

BCCM = STEP (0) 

YCOH = STBPjOj 

♦ EBBOB SIGNALS POSITION FEEDBACK 

EP = PCOH-P 
EY = YCOH-Y 

♦ EBBOB SIGNALS VELOCITY FEEDBACK 

EIP = EP-(KBTH*P1D0T) 

EIY = EY-iKBlH*YlDOT) 

CAP = KTH*EIP 
CflY = Kia+EIY 

♦ SBBVO TBANSFEB FUNCTION IB PITCH 



SVP = INTGBL (O.SVPDOT) 
SVPDOT = IBTGBl iO,SVP^DT 



PATH 






SVP2DT = INTGBL (0-SVP3DT1 
SVP3DT = A*(CflP-SVP) - E*S¥P2DT - 



♦ PITCH DEFLECTION 

PDEFL = LIMIT 1-0.0873 

* SEBVO TBANSFEB EUBCTION 



SVY = INTGBMO.SVYDOT) 



-.,0.0073, SVP) 
IN YAH PATH 



SVYDOT = INTGBL 
SVY2DT - INTGBL 



[0,SVY2DT) 
[0,SVY3DT) 



♦ YAH 



SVY3DT = A*{CMY-SVY) - E»SVY2DT - 

n 1? F T F r* T T n N 

YDEFL = LIMIT i-0. 0873, 0.087 3, SVY) 



JY = J1*MASS 
az = JY 
JX = J2+MASS 
ZP - TST*L/JY 
ZY = TS1*L/JZ 

♦ CBOSS COUPXE HDLIIPLIEBS 

ALPHA = CJZ-JX) ♦BOLL/JY 
BETA = iJX-JY) ♦BOLL/J2 

♦ CBOSS COUPLE TBBH YAH TO PITCH 

CCYP = ALPHA*Y1D0T 

♦ CBOSS COUPLE TEBM PITCH TO YAH 

CCPT = BETA*P1D0T 

♦ PITCH ANGULAB ACCELEBATION 

P2DOT = (ZP*PDEFLi ♦ CCYP 
« YAH ANGULAB ACCELEBATION 



Y2DOT = 

PITCH ANGOLA 

PIDOT = INTGBL 



(ZY + YDEFL) 
fi VELOCITY 



♦ CCPY 



* YAH 



PIDOT = INTGBL |0,P2DOT) 
P = INTGBL (0, PIDOT) 
ANGULAB VELOCITY 



YIDOT = INTGEl<0,Y2DOT) 
Y = INTGBL (0, YIDOT) 



* OUTPUT AND CONTBOL 
TEBMINAL 

CONTBL FINTIH=500.0, 
PBINT 0.50,P,Y 
END 
STOP 



DELT=0.01 



C*SVPDOT 



C»SVYDOT 
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